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A tracking control robot controls its arm end, which holds a tool, to track a taught path so that a reaction 
force between a workpiece and the tool remains constant. An ideal state for the arm end is determined from 
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Deutschsprachige Ubersetzung der Beschreibung 

der Europaischen Pat entanmel dung Nr. 89 306 554.0-2302 

des Europaischen Patents Nr. 0 349 291 



Diese Erfindung bezieht sich auf einen Verschiebungs- 
Steuerungsroboter bzw. einen Trackings teuerungsroboter zum 
Steuern der Bewegung eines Werkzeugs, das am Ende eines Robo- 
terarms befestigt ist, urn einem Vorgabepfad zu folgen, wah- 
rend eine gewunschte Kraft zwischen dem Werkzeug und einem 
Werkstuck auf rechterhalten wird. 

Stand der Technik 

Fur Bearbeitungsvorgange einschlieSlich Entgraten, PreS- 
polieren, Abgraten und Polierlappen wurde von einem Indu- 
strieroboter gefordert, eine Ruckwirkungskraf t zu steuern, 
die von einem zu bearbeitendem Objekt (im folgenden Werk- 
stuck) und einem Werkzeug, wie z.B. einem Schleif stein, das 
am Ende des Roboterarms befestigt ist, ausgeubt wird. 

Ein solcher Roboter wurde im Bericht "Force Control Sy- 
stem of a Light-weight Multi-articulated Robot Arms" No. 3209 
des dritten Symposiums der Robotics Society of Japan, das am 
28, 29 und 30 November 1985 abgehalten wurde, . vorgestellt . 
Entsprechend diesem Bericht hat der Roboter zwischen seinem 
Armende und einem Werkzeug einen Verschiebung- in- Kraft -Um- 
wandlungsmechanismus mit einer vorbestimmtren Beziehung zwi- 
schen einer Kraft, die in eine vorbestimmte Axialrichtung 
ausgeubt wird, und einer Verschiebung in die gleiche Axial- 
richtung. Der Roboter hat ebenfalls einen Kraftsensor zum Er- 
fassen einer Ruckwirkungskraf t, die durch ein Werkstuck auf 
das Werkzeug ausgeubt wird. Der Roboterarm wird mit diesem 
Kraftsensor genauestens gesteuert, um die erfaSte Ruckwir- 
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kungskraft auf einen vorbestimmten Wert zu regulieren. 



Der vorstehend genannte Verschiebung- in-Kraf t-Umwand- 
lungsmechanismus, der ebenfalls als Nachgiebigkeitsmechanis - 
mus bezeichnet wird, weist ein elastisches Element auf, wie 
z.B. eine Feder, einen Gummiabschnitt usw. Durch das Regulie- 
ren der Verschiebung in eine vorbestimmte Axialrichtung kann 
die durch das Werkzeug auf das Werkstuck ausgeiibte Kraft ge- 
steuert werden. 

Bei diesem Roboter nach dem Stand der Technik wird das 
Armende gesteuert, um einem Standardpfad zu folgen, der durch 
Positionsdaten bestimmt ist, die wahrend eines vorhergehenden 
Vorgabeprozesses gespeichert werden . Wahrend des Folgens des 
Pfades erfaSt der im Armende installierte Kraftsensor die vora 
Werkstuck zum Werkzeug ubertragene Ruckwirkungskraf t . 

Durch das Anwenden der erfaSten Ruckwirkungskraf t auf 
eine Bewegungsgleichung eines materiellen Teilchens wird eine 
Positionsabweichung Axi (die Differenz zwischen der Istposi- 
tion des Armendes und einer Position des Armendes, in der 
eine gewunschte. Ruckwirkungskraf t erhalten werden kann) be- 
rechnet. Nachfolgend wird eine nachste Sollposition xi fiir 
das Armende berechnet, ihdem die Positionsabweichung Axi zur 
letzten Sollposition xi-l addiert wird. Dann wird der Arm in 
die berechnete Sollposition bewegt. 

Durch das Wiederholen dieses Vorgangs wird die vom Werk- 
zeug auf das werkstuck ausgeiibte Kraft auf einem konstanten 
Wert gehalten. 

GemaS Vorbeschreibung wird die Sollposition xi entspre- 
chend der folgenden Gleichung berechnet : 

xi = xi-i + Axi 



Im allgemeinen ist jedoch die Position, in der die Ruck- 
wirkungskraf t vom Kraftsensor eingegeben wird, nicht die 
gleiche wie die letzte Soilposition xi-1. Diese Differenz 
wird verursacht, da das Korrektursignal fur die Position und 
die Lage des Armendes sich auf die durch den Kraftsensor er- 
faSte Ruckwirkungskraf t stutzend in Intervallen von einigen 
zehn Millisekunden erzeugt wird, wahrend es sogar einiger 
hundert Millisekunden bedarf , urn das Armende zur Soilposition 
und Soilage zu bewegen. Als Ergebnis wird ein weiteres Kor- 
rektursignal fur die Position und die Lage des Arms erzeugt, 
bevor der Arm die Soilposition und Soilage erreicht. 

Diese Situation ist in den Fig. 14A und 14B gezeigt, die 
die Bewegung des Armendes des Roboters nach dem Stand der 
Technik darstellen, wahrend ein Werkstuck mit einem unebenen 
Oberf lachenprof il f ertigbearbeitet wird. Die Vollinie in den 
Zeichnungen zeigt die Istbewegung des Roboterarmendes an, die 
gestrichelte Linie zeigt den Sollwert der Bewegung des Armen- 
des an und die Strichpunktlinie zeigt die Idealposition des 
Armendes mit einer vorbestimmten Ruckwirkungskraf t an. Das 
Armende bewegt sich in der Zeichnung von links nach rechts, 
wahrend das Werkstuck bearbeitet wird. 

In Fig. 14A wird die Verschiebung des Nachgiebigkeitsme- 
chanismus, die dem Output des Kraft sensors entspricht, als 
Positionsabweichung Ax ohne Abwandlung verwendet. In diesem 
Fall bewegt sich das Armende wie f olgt . 

Bis zum Erreichen des Punktes N=2 durch das Armende ist 
der Abstand zwischen dem Armende und dem Werkstuck konstant, 
so daS die Ruckwirkungskraf t des Werks tucks gegen das Werk- 
zeug ebenfalls konstant ist. 

Nachdem das Armende den Punkt N=2 erreicht hat, uber- 
steigt der Abstand zwischen dem Armende und dem Werkstuck 
. einen vorbestimmten Wert; die vom Werkzeug auf das Werkstuck 
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ausgeubte Kraft verringert sich. Urn diesen Verlust auszuglei- 
chen, wird der Sollwert des nachsten Punktes (N=3) einge- 
stellt, indem die Differenz zwischen der Idealposition und 
der Istposition des Armendes zum Sollwert des letzten Punktes 
5 (N=2) addiert wird. 

Zum Zeitpunkt N=3 ubersteigt der Abstand zwischen dem 
Armende und dem Werkstuck noch einen voreingestellten Wert, 
so daS der Sollwert des nachsten Punktes (N=4) korrigiert 
werden mu£. Im Punkt N=3 hat das Armende jedoch noch nicht 

10 den Sollpunkt erreicht. Demzufolge wird die nicht regulierte 
Positionsabweichung zum Sollwert des nachsten Punktes (N=4) 
addiert. Die nicht regulierten Positionsabweichungen werden 
in den folgenden Punkten auf einanderf olgend gesammelt . Als 
Ergebnis verursacht das Steuerungssystem ein Uberschwingen 

15 und eine Schwingung, wie es in Fig. 14A gezeigt ist . 

Um die vorstehend genannten Probleme zu losen, ist es 
moglich, eine Positionsabweichung zu verwenden, die bestimmt 
wird, indem ein Koeffizient, der kleiner als l ist (z.B. 1/3 
oder l/4) und die Verschiebung des Nachgiebigkeitsmechanis - 
20 mus, die dem Kraf tsensor-Output entspricht, mult ipliziert 
werden . • 

In diesem Fall wird jedoch eine langere Zeit benotigt, um 
einen gewunschten Wert fur die vom Werkzeug auf das Werkstuck 
ausgeubte Kraft zu erreichen, auch wenn ein Uberschwingen 
25 niemals auftritt. In Fig. 14B werden zum Beispiel zehn Pro- 
zefischritte benotigt. 

Wahrend sich die durch das Werkzeug auf das Werkstuck 
ausgeubte Kraft auSerhalb des gewunschten Wertes befindet, 
verschlechtert sich die Bearbeitungsgenauigkeit . 

30 Um das Problem zu losen, das durch die Zeitverzogerung 

zwischen der Zeit, wenn der Sollwert ausgegeben wird und wenn 
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der Arm tatsachlich den Sollwert erreicht, verursacht wird, 
istes moglich, das nachste Korrektur signal auszugeben, nach- 
dem der Arm den Sollwert erreicht hat. 

Da nach dem Output des Sollwertes einige hundert Millise- 
5 kunden benotigt werden, urn gemaS Vorbeschreibung den Arm in 
die Sollposition zu bringen, benotigt in diesem Fall jeder 
Steuerungsschritt ebenfalls einige hundert Millisekunden. 
Demzufolge wird die Bearbeitungsgeschwindigkeit betrachtlich 
verringert. Dieses Verfahren ist daher nicht verwendbar. 

10 Der vorstehend genannte herkommliche Roboter folgt dem 

Standardpfad sich auf die Vorgabedaten stutzend. Wenn eine 
betrachtlich Korrektur fur die Position des Roboterarms er- 
forderlich ist, kann der Arm vom Standardpfad deutlich abwei- 
chen, da die Position unabhangig von den Vorgabedaten korri- 

15 giert wird. 

Zusammenf assung der Erfindung 

Eine Aufgabe der vorliegenden Erfindung besteht darin, 
die vorstehend genannten Probleme zu losen und einen 
Trackingsteuerungsroboter vorzusehen, der Vorgabedaten fest- 
20 halt, urn eine genaue Sollposition zu bestimmen, so daS eine 
gewunschte Ruckwirkungskraf t , die durch ein Werkstuck auf ein 
Werkzeug ausgeubt wird, erhalten werden kann. 

Eine andere Aufgabe der vorliegenden Erfindung besteht 
darin, einen Trackingsteuerungsroboter vorzusehen, der die 
25 durch das Werkstuck auf das Werkzeug ausgeubte Ruckwirkungs - 
kraft in Echtzeit ohne Verringerung der Robot erbetriebsge- 
schwindigkeit reguliert. 

Eine weitere Aufgabe der vorliegenden Erfindung besteht 
im Vorsehen eines Trackingsteuerungsroboters mit verbesserter 
30 Ansprechempf indlichkeit und Genauigkeit zum Steuern der Posi- 



tion und der Lage des Werkzeugs . 

Zur Losung dieser und anderer Aufgaben sieht die vorlie- 
gende Erfindung einen Trackingsteuerungsroboter entsprechend 
Patentanspruch l vor . 

Kurze Beschreibuna der Zeichnunaen 

Fig, 1 ist ein Blockdiagramm, das eine Grundstruktur der 
vorliegenden Erfindung zeigt. 

Fig. 2 ist eine perspektivische Ansicht eines- Roboters 
und eines Steuerungssystems als ein Ausfuhrungsbeispiel der 
vorliegenden Erfindung. 

Die Fig. 3A, 3B und 3C sind eine Draufsicht, eine Vorder- 
ansicht bzw. eine Ansicht von links eines Arbeitskorpers des 
Roboters . 

Fig. 4 ist eine perspektivische Ansicht, die ein Roboter- 
armende zeigt. 

Fig. 5 ist ein Blockdiagramm, das die Struktur einer Ro- 
botersteuerungseinrichtung zeigt . 

Fig. 6 ist ein Blockdiagramm, das den Regelungsabschnitt 
der Robotersteuerungseinrichtung zeigt. 

Fig. 7 ist eine Darstellung, die die Positionsbeziehung 
zwischen verschiedenen Kontrollpunkten anzeigt. 

Fig. 8 ist eine Darstellung von Kraftdaten, die durch 
einen Kraft sensor erfaSt werden. 

Fig. 9 ist eine Darstellung, die die Erfassung einer An- 
derung der Ruckwirkungskraf t zeigt. 
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Fig. 10 ist ein FlieSdiagramm, das Steuerungsvorgange an- 
zeigt, die in einer ersten CPU ausgefuhrt v/erden. 

Fig. 11 ist ein- Fliefidiagramm, das Steuerungsvorgange an- 
zeigt, die in einer zweiten CPU ausgefuhrt werden. 

5 Fig. 12 ist eine Darstellung, die die Bewegung des Robo- 

terarmendes des vorliegenden Ausfuhrungsbeispiels zeigt. 

Fig. 13 ist eine perspektivische Ansicht, die ein weite- 
res Beispiel eines Nachgiebigkeitsmechanismus zeigt. 

Die Fig. 14A und B sind Darstellungen der Bewegung des 
10 Armendes der Roboter nach dem Stand der Technik. 

Detaillierte Beschreibung des bevorzuaten Ausfuhrungsbei- 
spiels 

Die vorliegende Erfindung bezieht sich auf einen sechs- 
achsigen Gelenkroboter zum Schleifen oder Polieren eines 
15 Werkstucks unter Verwendung eines Schleif steins als ein Werk- 
zeug, wahrend zwischen dem Werkstuck und dem Werkzeug eine 
konstante Ruckwirkungskr^f t auf rechterhalten wird. 

Die Struktur des Roboters 10 ist in Fig. 2 gezeigt . Der 
Roboter 10 ist mit einer Robotersteuerungseinrichtung 12 zum 

20 Steuern des Betriebes des Roboters 10, einem Vbrgabefach 14 
an der Robotersteuerungseinrichtung 12, das einer Bedienungs- 
person gestattet, dem Roboter 10 im voraus vorzugeben, wie 
eine Aufgabe auszufuhren ist # einem Arb^itskorper 16 mit 
sechs Achsen, der in Ubereinstimmung mit von der Roboter - 

25 steuerungseinrichtung 12 ausgesendeten Signalen betatigt 
wird, einem Werkzeug 2 0 und einem Kraftsensor 22 zum Erfassen 
der Ruckwirkungskraf t eines Werkstucks W gegen das Werkzeug 
20, wobei beide an einem Nachgiebigkeitsmechanismus 19 an 
einem Amende 18 am Arbeitskorper 16 befestigt sind, und 
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einer Sensorsteuerungseinrichtung 24 zum Verarbeiteii des vom 
Kraftsensor 22 ausgesendeten Signals ausgeriistet . AuEerdem 
weist die Robotersteuerungseinrichtung 12 eine Datenstation T 
zur Eingabe und Ausgabe und einen Drucker P auf . 

5 Detaillierte Erlauterungen zu jedem Abschnitt des Robo- 

ters 10 werden dargelegt. Als erstes wird der Arbeitskorper 
16 des Roboters 10 unter Bezugnahme auf die Fig. 3 A, 3B bzw. 
3C erlautert, die eine Draufsicht, eine Vorderansicht und 
eine Ansicht von links des Arbeitskorpers IS zeigen. Der Ar- 
10 beitskorper 16 hat sechs Drehachsen. Die erste, die zweite 
und die dritte Achse steuern die Position des Armendes 18 in 
bezug auf das Werkstuck W; die vierte, die funfte und die 
sechste Achse steuern die Lage des Armendes 18 in Beziehung 
zum Werkstuck W. 

15 Jede Achse hat einen Motor, eine Bremse zum Stoppen der 

Drehung und einen Kodierer zum Erfassen der Rotationsge- 
schwindigkeit der Achse: die erste Achse weist einen ersten 
Motor 30, eine erste Bremse 32 und einen ersten Kodierer 34 
auf, die zweite Achse weist einen Motor 40, eine zweite 

20 Bremse 42 und einen zweiten Kodierer 44 auf, die dritte Achse 
weist einen dritten Motot 50, eine dritte Bremse 52 und einen 
dritten Kodierer 54 auf, die vierte Achse hat einen vierten 
Motor 60, eine vierte Bremse 62 und einen vierten Kodierer 
64, die funfte Achse weist einen funften Motor 70, eine funf- 

25 te Bremse 72 und einen funften Kodierer 74 auf und die sech- 
ste Achse weist einen sechsten Motor 80, eine sechste Bremse 
82 und einen sechsten Kodierer 84 auf. 

Die Drehungen um die zweite Achse und die dritte Achse 
durch die Motoren 4 0 und 50 werden uber Kugelumlauf spindel- 
30 vorschube 9 0 und 92 in lineare Bewegungen umgewandelt; die 
linearen Bewegungen werden durch Parallelverbindungen in Dre- 
hungen um die Achsen umgewandelt. Die Drehungen um die ande- 
ren Achsen werden uber Verdrehrohre, Untersetzungsgetriebe, 
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Schraubgetriebe und andere Ubertragungselemente durch jewel - 
lige Motoren ausgelost. 

In Fig. 4 hat das Armende 18 einen Schleif stein 20, einen 
Motor 100, einen Nachgiebigkeitsmechanismus 19 und einen 
Kraftsensor 22. Der Schleif stein 20 ist ein Werkzeug zum Be- 
arbeiten des Werks tucks W. Der Motor 100 ist uber ein Getrie- 
be (nicht gezeigt) mit dem Schleifstein 20 verbunden, um den 
Schleif stein 20 zu drehen. Der Nachgiebigkeitsmechanismus 19 
besteht aus einer. Feder 102 und Dampfungsvorrichtungen 104 
und gleitet mit Ruckwirkungskraf ten nur in die in Fig. 4 ge- 
zeigte Verschiebungsrichtungen. Der Kraftsensor 22 ist zwi- 
schen dem Nachgiebigkeitsmechanismus 19 und dem Armende 18 
montiert, um die durch das Werks tuck W auf den Schleifstein 
20 ausgeubte Ruckwirkungskraf t zu erfassen. Das Verhaltnis 
zwischen der Verschiebung des Nachgiebigkeitsmechanismus 19 
und der Kraft wird im voraus bestimmt. 

Der Kraftsensor 22 verwendet in diesem Ausf uhrungsbei- 
spiel ein Dehnungsmefigerat zum Erfassen von Kraften in drei 
Achsrichtungen und von Drehmomenten um die drei Achsen herum, 
die aus einer Achse in Verschiebungsrichtung des Nachgiebig- 
keitsmechanismus 19 und % zwei Achsen bestehen, die zur Ver- 
schiebungsachse senkrecht verlaufen und zueinander ebenfalls 
senkrecht verlaufen. 

Die Kraf tdaten Fsen (KHi) , die durch den Kraftsensor 22 
erfafit werden, stellen die Kraft und das Moment entlang jeder 
Achse in einem Sensorkoordinatensystem 0-Xs-Ys-Zs mit dem Ur- 
sprung 0 an der Position des Kraftsensors 2.2 dar. Die Kraft- 
daten werden durch den folgenden sechsdimensionalen Vektor 
ausgedruckt : 

Fsen=(Fxs, Fys, Fzs, MNxs, MNys, MNzs) T , wobei T eine 
transponierte Matrix anzeigt, F Kraft bedeutet, MN Moment be- 
deutet und xs, ys r zs die Sensorachsen sind. 
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In diesem Ausfuhrungsbeispiel entspricht die zs-Achse des 
Sensorkoordinatensys terns der Verschiebungsachse des Nachgie- 
bigkeitsmechanismus 19 . 

Als nachstes wird die Struktur der Robotersteuerungsein- 
richtung 12 dargelegt, die den sechsachsigen Arbeit skorper 16 
steuert und ebenfalls als ein Vorgabesystem fur den Roboter 
10 arbeitet. 

Die Roboter steuerungseinrichtung 12, die in Fig. 5 gra- 
phisch dargestellt ist, ist ein Mikrorechner , der eine erste 
CPU 3 00, eine zweite CPU 3 01, einen ROM 3 02, einen RAM 3 04 
und einen Sicherungs-RAM 3 06 aufweist, die bekannt sind und 
uber einen Bus 308 mit Ein-Ausgabe-Anschlussen verbunden 
sind. 

Ein-Ausgabe-Anschlusse, die mit der ersten CPU 300 und 
der zweiten CPU 3 01 als Hauptkomponenten der Robotersteue- 
rungseinrichtung 12 zusaitimenwirken, weisen auf : eine Blasen- 
speicher-Sctinittstelle 312 fur eine Blasenspeicher 310, einen 
Datenstation-Ein-Ausgabe-Anschlu£ 314 fur eine Datenstation 
T, die eine Kathodenstrahlrohren-Anzeige und eine Tastatur 
hat, einen Drucker-Ausgabe-AnschluS 316 fur einen Drucker P, 
einen Vorgabef ach-Eingabe-Anschlu£ 318 fur das Vorgabefach 
14, einen. Sensor- Eingabe-AnschluS 230 zum Aufnehmen elektri- 
scher Signale, die vom Kraft sensor 22 uber eine Sensor steue- 
rungseinrichtung 24 ausgesendet" wurden, und zum Erzeugen 
eines Interrupts in der zweiten CPU 301 und Servokreise .320, 
322, 324, 326, 328 bzw. 330 fur die erste bis sechste Achse . 

Jeder Servokreis 320 bis 330 ist ein intelligenter Kreis 
mit eigener CPU. wenn die Sollpositionsdaten und die Soilage - 
daten fur den Schleif stein 2 0 von der ersten CPU 30 0 uber den 
Bus 308 geschickt werden, wird der Stellbetrag fur die ein- 
zelnen sechs Achsen von den Kodierern 34, 44, 54, 64, 74 und 
84 eingegeben. Sich auf diese Stellbetrage stutzend werden 
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der erste bis sechste Motor 30, 40 , 50, 60, 70 und 80 uber 
die jeweiligen Treiber 332, 334, 336, 338, 340 und 342 ange- 
trieben. Dann wird die Spitze des Schleif steins 20 in Sollpo- 
sition und Soilage gebracht . Daruber hinaus treiben die 
ersten bis sechsten Servokreise 320, 322, 324, 326, 328 bzw. 
330 die erste bis sechste Bremse 32, 42, 52, 62, 72 und 82 
an, so daS, wenn die Umstande es erforderlich machen, verhin- 
dert wird, dafi der Arm durch sein Eigengewicht betatigt wird 
oder sich herabbewegt, wenn die Stromversorgung fur die Ser- 
vokreise 32 0 bis 330 Oder fur die Motoren 30, 40, 50, 60, 70 
und 80 fur einen Nothalt ausgeschaltet wird. 

■Der Betrieb der Robotersteuerungseinrichtung 12 wird im 
Anschlufi beschrieben. Das Regelungs system der Robotersteue- 
rungseinrichtung 12 besteht hauptsachlich aus zwei Abschnit- 
ten, d.h. der ersten und der zweiten.-CPU 300 und 301, wie es 
in Fig. 6 gezeigt ist. Die erste CPU 300 sendet Standardpf ad - 
daten PTpath(KHl) , die durch Interpolierung der zuvor vorge- 
gebenen Daten erhalten werden, zur zweiten CPU 301. Dann 
nimmt die erste CPU 300 einen Anf angssollwert PTmod(KHl) auf, 
der durch einen Korrekturbetrag modifiziert ist. Sich auf 
diesen Anf angssollwert PTmod(KHl) stutzend wird ein Endsoll- 
wert Ghost (KHl) fur jede' Achse berechnet und zu jedem Servo- 
kreis gesendet, der der Betriebssteuerungsabschnitt ist. 

Andererseits berechnet die zweite CPU 301 einen Korrek- 
turbetrag APT (KHl) , der auf den Kraftdaten vom Kraftsensor 
22, den Lagedaten des Armendes 18, simultan mit den Kraftda- 
ten, und den Standardpf addaten PTpath(KHl) von der ersten CPU 
3 00 basiert. Durch das Addieren eines Versetzbetrages zum be- 
rechneten Korrekturbetrag berechnet die zweite CPU 3 01 eine 
Sollwert PTmod (KHl) , urn diesen zur ersten CPU 300 zu senden. 

Es wird eine detaillierte Erlauterung der Steuerung durch 
die erste CPU 300 dargelegt. Bevor der Roboter 10 mit einer 
speziellen Aufgabe beginnt, verwendet eine Bedienungsperson 
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das Vorgabefach 14, um dem Roboter 10 in der gleichen Weise 
wie bei herkommlichen Robotern mitzuteilen, welche Bearbei- 
tungspunkte das Werkzeug am Werkstuck W abfahren soil und 
welche Lage das werkzeug einnehmen soil . Solche Daten werden 
in einem Vorgabepunktspeiclier 40 0 im RAM 3 04 gespeichert. 

Die Vorgabepunktdaten stellen die Werte dar, die die Ba- 
siskoordinaten des Roboters und den Bearbeitungspunkt des 
Werkzeugs verbinden. Der m-te Punkt der Vorgabedaten ist 
durch die folgende Matrix gezeigt: 



PTtch tm] = 



NX OX AX X 

NY OY AY Y 

NZ. OZ AZ Z 

0 0 0 1 



(1), wobei 



NX, NY und NZ die X-Y-Z-Komponenten eines Normalenvektors 
sind, OX, OY und OZ die X-Y-Z-Komponenten eines Ausrichtungs - 
vektors sind, AX, AY und AZ die X-Y-Z-Komponenten eines Zu- 
stellvektors sind und X, Y und Z die X-Y-Z-Komponenten eines 
Posit ionsvektors des m-ten Vorgabepunktes sind. Jede Kompo- 
nente des Vektors wird durch ein Koordinatensystem 0-XYZ 
(siehe Fig. 2) mit dem Ursprung 0 am vorbestimmten Standard- 
punkt des Arbeit skorpers 16 dargestellt. 



Der Normal envekt or , der Ausrichtungsvektor und der Zu- 
stellvektor, die zueinander senkrecht sind, zeigen die Ar- 
beitsrichtung des Werkzeugs am Vorgabepunkt an, der durch die 
vorstehende Matrix gezeigt ist. Die variablen zum Anzeigen 
der Punkte, auf die sich in der folgenden Erlauterung bezogen 
wird, sind ebenfalls durch den gleichen Matrizentyp darge- 
stellt . 



Nach dem Vorgabevorgang beginnt der Roboter 10 in Erwide- 
rung auf ein Vorgangs start signal mit der speziellen Aufgabe. 
Zuallererst interpoliert eine Pf adinterpolierschaltung 402 
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die Daten PTtch(KHO) vom KHO-ten vorgabepunkt , die vom Vorga- 
bepunktspeicher 40 0 ausgesendet wurden, und berechnet dann 
Standardpf addaten PTpath(KHl) fur das Werkzeug 20. Diese 
Standardpf addaten PTpath(KHi) legen einen Standardpf ad fest, 
5 dem das Werkzeug 20 folgen soil. Anschliefiend werden die 
Standardpf addaten PTpath(KHl) zur zweiten CPU 301 gesendet, 
die Daten PTmod(KHl) mit modif iziertem Sollpunkt produziert, 
die die CPU 3 01 zu einer Schaltung 404 fur inverse kinemati- 
sche Transformation sendet. 

10 Die Schaltung 404 fur inverse kinematische Transformation 

wandelt die Daten PTmod (KHl) mit modif iziertem Sollpunkt in 
Rotationswinkeldaten Ghost (KHl) fur jede der sechs Achsen 
um. Die Rotationswinkeldaten werden zu den entsprechenden 
Servokreisen 32 0 bis 33 0 gesendet. Dann werden uber die ent- 

15 sprechenden Treiberschaltungen 332 bis 342 die Motoren 30, 

40, 50, 60, 70 und 80 fur jede Achse angetrieben, um den Be- 
arbeitungspunkt des Schleif steins 20 zu dem Punkt zu ver- 
schieben, der den Daten PTmod (KHl) mit modif iziertem Soll- 
punkt entspricht. Fig. 7 zeigt die Beziehung zwischen dem 

20 Schleifstein 20, dem Werkstuck W, PTpath(KHl) , APT (KHl ) und 
PTmod (KHl) . 

Im folgenden schlieSt sich unter Bezugnahme auf Fig. 6 
die Erlauterung der. zweiten CPU 3 01 zum Bestimmen der Daten 
PTmod (KHl) mit modif iziertem Sollpunkt an. Die zweite CPU 301 

25 fuhrt ihren Prozefi parallel mit der ersten CPU 300 aus.- Der 
Zeitintervall in der ersten CPU 300 zum Ubertragen von 
PTpath(KHl) zur zweiten CPU 301 ist gleich dem Gesamtzeitin- 
tervall in der zweiten CPU 301 zum Empfangen von PTpath(KHi) 
von der ersten CPU 300, zum Berechnen der Korrekturdaten 

30 PTmod (KHl) und zum Ubertragen von diesen zur ersten CPU 30 0 
zuruck. 

Wenn PTpath(KHl) von der ersten CPU 300 aufgenommen wird, 
beginnt die zweite CPU 301 mit ihrem SteuerungsprozeS. Als 
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erstes wird jeder Satz von Rotationswinkelsdaten Gene (KHl) 
von den Kodierern 34, 44, 54, 64, 74 und 84 der sechs Achsen 
in der Schaltung 406 fur kinematische Transformation unter 
Verwendung der folgenden Gleichung in Flanschendedaten 
PF(KHl) umgewandelt : 

PF(KHl) = A[0enc(KHl) ] . . . (2) , 

wobei A eine kinematische Transformation und [Gene (KHl)] 
ein Winkelvektor ist. 

AnschlieSend berechnet eine Werkzeugbearbeitungspunktko- 
ordinaten-/Sensorkoordinaten-Berechnungsschaltung 40 8 unter 
Verwendung der Flanschendedaten PF(KHl) in den folgenden For- 
meln (3) und (4) Sensorendedaten. PS (KHl) und Istpositionsda- 
ten PTenc (KHl) : 

PS (KHl) = PF(KHl) • II f -> s ...(3) 

PTenc (KHl) = PF(KHl) • n f -* t ...(4), in denen 

Ilf^ s eine Position/Lage-Matrix ist, die die Position des 
Sensorendes in Beziehung' zum Flanschende des Werkzeugs dar- 
stellt, und IIf-> t eine Position/Lage-Matrix ist, die die Po- 
sition des Bearbeitungspunktes in Beziehung zum Flanschende 
darstellt . 

Der Zweck der vorstehenden Umwandlung besteht darin, die 
Kraft und das Moment jeder Achse am Kraftsensor 22 in die an 
der Position des Werkzeugs 2 0 umzuwandeln. _ 

Wenn die Flanschendedaten PF(KHi) eingegeben werden, wer- 
den Kraftdaten Fsen(KHl) vom Kraftsensor 22 uber die Sensor- 
steuerungseinrichtung 24 ebenfalls eingegeben. Die Kraftdaten 
Fsen(KHl) stellen gemaS Vorbeschreibung Kraft und Moment je- 
der Achse der Sensorkoordinate 0-Xs-Ys-Zs mit dem Ur sprung 0 
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an der Position des Kraftsensors 22 dar. Die Kraftdaten 
Fsen(KHl) werden durch einen' sechsdimensionalen Vektor darge- 
stellt. 

Die Kraftdaten Fsen(KHl) setzen sich aus einer Gewichts- 
kraft Mtool des Werkzeugs 2 0 und einer Ruckwirkungskraf t Fw, 
die vom Werkstuck W auf das Werkzeug 20 ausgeubt wird, zusam- 
men. In diesem Ausf uhrungsbeispiel wird angenommen, daS die 
Ruckwirkungskraf t Fw gleich einem Sollwert Fzo ist, der zuvor 
in einem Sollkraf tspeicher 412 des RAMs 304 gespeichert wird. 
Wenn sich der Roboter 10 im freien Raum bewegt und die Lage 
des Armendes 18 andert, andert sich ebenfalls die Werkzeugge- 
wichtskraft fur jede der sechs Achsen, die durch den Kraft - 
sensor 22 erfaSt wird. 

Zur Erleichterung der Erlauterung der Anderung der Werk- 
zeuggewichtskraf t aus der Werkzeuglageanderung wird das Werk- 
zeug 20 nur in Gleitrichtung des Nachgiebigkeitsmechanismus 
19, d.h. in Verschiebungsrichtung, reguliert. AuSerdem ent- 
spricht die Gleitrichtung sowohl der Zs-Achse des Sensorkoor- 
dinatensystems als auch der in Fig. 4 gezeigten Verschie- 
bungsrichtung des Nachgiebigkeitsmechanismus 19 . Wie es in 
Fig. 8 gezeigt ist, ist 'eine Zs -Achsen- Komponente der Kraft- 
daten Fsen eine Differenz zwischen einer Zs -Achsen- Komponente 
Ftool der Werkzeuggewichtskraf t und der Ruckwirkungskraf t Fw 
des Werkstucks w. Wenn der Winkel zwischen der Korrekturrich- 
tung (Zs-Achse) und der Gravitationsrichtung 

(strichpunktierte Linie) 0 ist, wird die Zs -Achsen- Komponen- 
te Ftool der Werkzeuggewichtskraf t mit der Forrael Ftool = 
Mtool • cosG berechnet. Wenn die vom Werkstuck W auf das 
Werkzeug 2 0 ausgeubt e Ruckwirkungskraf t durch Fw dargestellt 
ist, wird die Zs -Achsen- Komponente Fzs der Kraftdaten Fsen 
entsprechend den folgenden Formeln berechnet: 



Fzs = Mtool • cos© - Fw 



= Ftool - Fw 



16 
. (5) 



Die an jede Achse angelegte Werkzeuggewichtskraf t wird in 
der Werkzeuggewichtskraf t - Berechnungsschal tung 410 in Fig. 6 
berechnet. Als erstes wird der Wert cos0 auf den Sensorkoor- 
dinatendaten PS(KHl) basierend berechnet. Als nachstes wird 
die Werkzeuggewichtskraf t Ftool in Korrekturrichtung (Zs- 
Achse) unter Verwendung der vorgespeicherten Werkzeugdaten 
Mtool berechnet . 

Wenn die X-Y-Ebene des Roboterkoordinatensystems parallel 
zum Boden verlauft (siehe Fig. 2) , ist die Zs-Richtung des 
Roboterkoordinatensystems 0-X-Y-Z mit der Gravitationsrich- 
tung identisch, so daS der Wert von cosG durch das Entnehmen 
einer Komponente der Sensorkoordinatendaten PS(KHl) erhalten 
werden kann. Und zwar stellen die Sensorkoordinatendaten 
PS(KHl) eine Relativposition und Relativlage des Sensorkoor- 
dinatensys terns in bezug auf das Roboterkoordinatensystem 0-X- 
Y-Z dar. Diese sind im folgenden gezeigt: 



PS(KHl) = 



Xsx Ysx Zsx X 

Xsy Ysy Zsy Y 

Xsz Ysz Zsz Z 

0 0 0 1 



(6) 



Dement sprechend wird der Winkel cos0, der durch die Z- 
Achse des Sensorkoordinatensystems und die Z -Achse des Robo- 
terkoordinatensystems festgelegt ist, wie folgt gezeigt: 

COS0 = Zsz . . . (7) 

Wenn die X-Y-Ebene des Roboterkoordinatensystems nicht 
mit dem Boden parallel ist, ist andererseits der Winkel cosG 
ein inneres Produkt eines Vektors G in Gravitationsrichtung 
des Roboterkoordinatensystems, d.h. (X, Y, Z) = (0, 0, l), 
und des Zs -Vektors (Zsx, Zsy, Zsz) der Sensorkoordinatendaten 



PS (KH1) . 
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cos 0 = (G • Zs) / ||G|| ' || ZH ... (8) 

Wenn eine Ruckwirkungskraf t , die urn AF grofier als eine 
Sollkraft Fzo ist, ausgeubt wird, kann eine solche Differenz 

5 AF in der folgenden Weise angegeben werden. In Fig. 9 stel- 
len dFtool, dFw und dAF die Verschiebung des Nachgiebig- 
keitsmechanismus 19 entsprechend den Kraften Ftool, Fw bzw. 
AF dar. Das Armende 18, das auf der linken Seite der Zeich- 
nung gezeigt' ist, befindet sich in einem Zustand, in dem die 

10 vom Werkstuck W ausgeubte Ruckwirkungskraf t gleich der Soll- 
kraft Fzo ist. Andererseits befindet sich. das Armende 18, das 
auf der rechten Seite der Zeichnung gezeigt ist, in einem Zu- 
stand, in dem sich das Armende 18 in den rechten Abschnitt 
des Werks tucks W bewegt hat, wo der Abstand zwischen dem 

15 Werkstuck W und dem Armende 18 urn do kurzer ist, wahrend die 
Ruckwirkungskraf t Fw vom Werkstuck W aus um AF grower ist. 

Wenn die Ruckwirkungskraf t Fw des Werkstucks W gleich der 
Sollkraft Fzo ist, ist die durch die Formel (5) gezeigte Be- 
ziehung erfullt. Wenn die Kraft AF zu Fw addiert wird, ist 
20 eine durch die folgende Formel (9) gezeigte Beziehung er- 
fullt, 

Fzs = Ftool - (Fw + AF) ... (9) 

Da die Werte Fzs, Ftool und Fw bereits bekannt sind, wird 
die zusatzliche Kraft AF durch Verwendung der folgenden For- 
25 mel erhalten: 

AF = -Fzs + Ftool - Fw . . . (10) 

Das berechnete AF ist der Betrag, der benotigt wird, um 
die Ruckwirkungskraf t zu korrigieren. Die Positionsabweichung 
Ad, die benotigt wird, um AF auf Null zu bringen, wird in 
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einer Abweichungsumwandlungsschaltung 414 in Fig. 6 erhalten. 



Wenn die Werkzeuggewichtskraf t Mtool (auf die sich im 
folgenden als M bezogen wird) unterhalb des Sensors ein mate- 
rielles Teilchen ist, ergibt sich eine in der folgenden Bewe- 
gungsglei chung gezeigte Beziehung. 

AF =MD +cb +KAd ...(11) 

In der vorstehenden Formel stellt. D die Werkzeugposition 
in Richtung der Zs-Achse dar, die sich auf die Position des 
Sensors stutzt; c und k zeigen jeweils eine viskositatskon- 
stante und eine Federkonstante des Nachgiebigkeitsmechanismus 
19 an. Aus der Formel (11) wird die Positionsabweichung d wie 
folgt erhalten; 

Ad =(AF — MD — cb) / K ...(12) 

Da die vorstehenden Berechnungen in jedem diskreten Zy- 
klus ausgefuhrt werden, ist Ad(KHl) ungefahr wie folgt. in 
der folgenden Gleichung ist r eine Zykluszeit, Ad(KHl-l) ist 
die Positionsabweichung Ad wahrend des letzten Zyklus und 
Ad(KHl-2) ist Ad wahrend des vorletzten Zyklus. Indem b und 
b unter Verwendung von Ad(KHl-l) und Ad(KHl-2) angenahert 
werden, wird Ad(KHl) angenahert als: 

Ad(KHl) = l/K- [AF 



M/r 2 (D(KHl-2) - 2D(KH1-1) + D(KH1)} 



c/r {D(KH1-D- D(KH1)}] ...(13), wobei 



D(KH1) = 



10 0 0 
0.10 0 
0 0 1 Ad(KHl) 



ist . 
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Wenn in den vorstehend genannten Formeln M und c •= o 
sind, dann ist Ad(KHl) = AF/K. Als Ergebnis wurden sich die 
Tragheits- und Viskositatsterme urn- einen Zyklus verzogern. Da 
jedoch Ad(KHl) = Ad(KHl - 1) ist, ist es moglich, wenn ein 
Zyklus r kuirzer als einhundert Millisekunden ist, die Posi- 
tionsabweichung Ad(KHl) in Beziehung zu AF unter Nichtbeach- 
tung der geringf ugigen Zyklusverzogerung zu berechnen. 

In einigen Fallen, wenn z.B. die Steuerung statisch ist 
Oder wenn M und die Konstante c aufierst kleine Werte sind, 
konnen sowohl M als auch c aus dieser Rechnung entfernt wer- 
den. 

Im vorliegenden Ausfuhrungsbeispiel werden die Positions - 
abweichungen Ad(KHl-l) und Ad (KHl -2) (d.h. die Werte einen 
Zyklus und zwei Zyklen vor Ad(KHl) ) zum Annahern der Werk- 
zeugposition D verwendet . Es ist ebenfalls moglich, Ad ( KHl + 
l) und Ad (KHl + 2) (d.h. die Werte einen Zyklus und zwei Zy- 
klen nach Ad (KHl) ) zu verwenden, um die Werkzeugposition an- 
zunahern, wie es in der folgenden Formel gezeigt ist: 

Ad (KHl) = 1/K- [AF 

- M/r 2 {d (KHl) - 2D(KH1+1) + D(KHl+2)} 

- c/r (D(KH1+1)- D(KHl+2)}] . ..(13 1 ) 

Sich auf den Positionsabweichungsbetrag Ad (KHl) in Bezie- 
hung zur Kraft AF und die Sensorkoordinatendaten PS (KHl) 
stutzend, wird in einer Idealpositions-Berechnungsschaltung 
416 (Fig. 6) eine Idealposition PSaim(KHl) des Sensors 22, an 
der die Ruckwirkungskraf t gleich der Sollkraft Fzo(KHl) ist, 
unter Verwendung der folgenden Formel berechnet : 



PSaim(KHl) = PS (KHl) -D(KHl) ...(14) 
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II s -> t wird wie folgt unter Verwendung von PTenc(KHi), der 
in Schritt 408 berechnet wurde, berechnet . 

n s -* t = PSaim(KHl) • 1 -PTaim(KHl) ...(14') 

PTaim(KHl) = PSaim(KHl) -II s -> t . . . (15 1 ) , wobei II s -» t eine 
5 Matrix darstellt, die die Position und die Lage der Werkzeug - 
bearbeitungspunktkoordinaten in Beziehung zu den Sensorkoor- 
dinaten anzeigt. 

Die Idealposition PSaim(KHl) , die Daten im Sensorkoordi- 
natensystem darstellt, wird in einer Werkzeugbearbeitungs- 
10 punkt-Umwandlungsschaltung 418 (Fig. 6) entsprechend der fol- 
genden Formel in Daten PTaim(KHl) im Robot erkoordinatensy stem 
umgewandelt : 

AnschlieSend wird Gleichung (16) verwendet, urn eine Ab- 
weichung R-ofs(KHl) zwischen der Idealposition PTaim(KHl) und 
15 den Standardpf addaten PTpath(KHl) zu erhalten, die unter Ver- 
wendung der Pf adinterpolierschaltung 402 erhalten wurden. 

R-ofs(KHl) = PTpath(KHl) -^PTaimtKHl) ....(16) 

» 

Das Verhaltnis R-ofs(KHl) wird verwendet, urn die Position 
in Korrekturrichtung zu korrigieren und eine Vorgabegeschwin- 

20 digkeit in Vorschubrichtung des Werkzeugs auf rechtzuerhalten, 
die zur Korrekturrichtung normal erweise senkrecht verlauft. 
Diese Korrektur unter Verwendung von R-ofs(KHl) ist notwen- 
dig # da die Werkzeug- Ist -Position in der Tat hinter der Stan- 
dardpf adpos it ion PTpath(KHl) , wie es in Fig. 7 gezeigt ist, 

25 liegt; die Idealposition des Werkzeugbearbeitungspunktes 
PTaim(KHl) , die der Werkzeug- Ist-Position entspricht, befin- 
det sich ebenfalls dahinter. Die Korrektur mit diesen verzo- 
gerten Werten verandert die Bewegungsgeschwindigkeit des 
Werkzeugs . 
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AnschlieSend bestimmt eine Korrekturelement-Auswahlschal- 
tung 420 (Fig. 6) durch das Anwenden des Verhaltnisses R- 
ofs(KHl) nur auf die Matrixkomponente, die dem durch den 
Kraftsensor 22 erfafiten Element entspricht, einen Korrektur- 
betrag APT(KHi) . Der Korrekturbetrag APT(KHi) wird wie folgt 
bestimmt: 



Apt (khi) = 



10 0 0 

0 10 0 

0 0 1 z 

0 0 0 1 



(17) 



In der vorstehenden Matrix ist Z gleich dem Element Z im 
Verhaltnis R-ofs(KHl). Der Korrekturbetrag APT (KHI) wird zu 
10 einer Abweichungserf a£schaltung 422 gesendet und mit einem 
vorbestimmten Wert /? verglichen. Wenn der absolute Wert 
||APT(KH1)|| von APT (KHI) groSer als (3 ist, kann der Robot er 

aus dem gewunschten Pfad davonlaufen. In diesem Fall wird ein 
Noteingriff, wie z.B. ein Nothalt, vorgenommen. Andererseits 
15 wird, wenn ||APT(KH1)|| kleiner als /3 ist, die nachsten Bear- 

beitungspunkt-Korrekturdaten PTpmod(KHl) unter Verwendung des 
Korrekturbetrags APT (KHI) entsprechend der folgenden Formel 
berechnet . , 

PTpmod(KHl) = PTpath(KHl) -APT(KHl) ...(18) 

■ 

20 Anschl'iefiend werden in einer Sollversetzungsschaltung 424 

die Daten PTmod(KHl) mit modif iziertem Sollpunkt sich auf 
einer Versetzung Ofs(KHl) vom Sollpunkt aus stutzend entspre- 
chend der folgenden Formel bestimmt. 

PTmod (KHI) = PTpmod(KHl) -Of s (KHI) ...(19), wobei 
25 PTpmod( KHI) eine Anf angs-Werkzeugende-Sollkoordinate anzeigt. 



Die Daten PTmod (KHI) mit modif iziertem Sollpunkt werden 
zur ersten CPU 300 ubertragen; der ProzeS in der zweiten CPU 
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301 ist abgeschlossen. 

Die vorstehend genannten Prozesse, die in der ersten CPU 
300 und der zweiten CPU 301 ausgefiihrt . werden, sind durch 
FlieSdiagramme der Fig. 10 bzw. 11 gezeigt. Die Robotersteue- 
rungseinrichtung 12 des vorliegenden Ausf uhrungsbei spiels 
weist zwei CPUs 30 0 und 301 auf, die in Fig. 6 gezeigt sind. 
Diese zwei CPUs 300 und 301 fuhren ihre jeweiligen Prozeduren 
parallel zueinander aus. 

Wenn der Roboter 10 in Antwort auf das vorgangsstartsi- 
gnal mit einer speziellen Aufgabe beginnt, fuhrt die erste 
CPU 300 die folgenden Schritte in Reihenfolge aus: 

Schritt 500 berechnet die Standardpf addaten PTpath(KHl) 
durch das Interpolieren der Vorgabepunktdaten PTtch(KHl) , die 
im Speicher 400 gespeichert sind. 

Schritt 502:' Aussenden der Standardpf addaten PTpath(KHl) 
zur zweiten CPU 3 01 und Anforderung der Daten PTmod(KHl) mit 
modif iziertem Sollpunkt von der zweiten CPU 301. 

Schritt 504: Aufnehmen von PTmod(KHl) von der zweiten CPU 

301 . 

Schritt 5 06: Umwandeln von PTmod(KHl) in den Rotations - 
winkel Ghost (KHl) fur jede Achse. 

Schritt 508: Aussenden des Rotationswinkels Ghost (KHl) 
zu den Servokreisen 320 bis 330 fur die sechs Achsen. 

Schritt 510: Inkrementieren von KHl urn 1 und Zuruckkehren 
zu Schritt 500, um die Schritte 500 bis 510 zu wiederholen. 

Die zweite CPU 301 fuhrt die folgenden Schritte aus: 
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Schritt 600: Aufnehmen der Standardpf addaten PTpath(KHi) 
von der ersten CPU 300. 

Schritt 602: Aufnehmen der Kraftdaten Fsen(KHl) von der 
Sensorsteuerungseinrichtung 24. 

5 Schritt 604: Aufnehmen der Rotationswinkeldaten 

Genc(KHl) von den einzelnen Achsenkodierern 34, 44, 54, 64, 
74 und 84 in dem Moment, wenn der Kraftsensor 22 mit seiner 
Messung beginnt. 

Schritte 606, 608, 610, 612, 614, 616 und 618: Berechnen 
10 von Ftool, AF, Ad(KHl), PSaim(KHl) , PTaim(KHl) , R-ofs(KHl) 

.und APT(KHl) gemaS ihren entsprechenden Formeln. 

Schritt 620: Vergleichen des Korrekturbetrags APT(KHl) 
mit dem vorbestimmten Wert /3. Wenn ||APT(KH1)|| > (3 ist, geht 
das Programm zu Schritt 628. Wenn || APT( KH1)|| < (3 ist, geht es 
15 zu Schritt 622. 

Schritt 622: Berechnen der Bearbeitungspunkt-Korrekturda- 
ten PTpmod(KHl) . 

Schritt 624: Berechnen der Daten PTmod(KHl) mit modifi- 
ziertem Sollpunkt. 

20 Schritt 626: Aussenden der Daten PTmod(KHl) mit modifi- 

ziertem Sollpunkt zur ersten CPU 300 und Ruckkehr zu Schritt 
600. 

Schritt 628: Anhalten des Roboters 10 als eine NotmaSnah- 
me und Beenden des Prozesses. 
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Durch das Wiederholen der vorstehend genannten ProzeS- 
schritte, fuhrt der Roboter 10 die Arbeit fort, wahrend die 
Kraft des Schleif steins 20 gegen das Werkstuck W entsprechend 
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der Sollkraft reguliert wird. 

Fig. 12 stellt die Bewegung des Armendes 18 dar, wenn ein 
Werkstuck W, das mit den fur die herkommlichen Roboter in den 
Fig. 14A und 14B verwendeten identisch ist, durch den Roboter 
des vorliegenden Ausf uhrungsbeispiels bearbeitet wird. In 
Fig. 12 zeigt die Vollinie die Bewegung des Armendes 18 an, 
die gestrichelte Linie zeigt den Sollwert des Armendes 18 an 
und die Strichpunktlinie die Idealposition des Armendes 18 
mit idealer Ruckwirkungskraf t . Wahrend der Bearbeitung des 
Werkstucks bewegt sich das Roboterarmende in der Zeichnung 
von links nach rechts. Fig. 12 zeigt deutlich, dafi der Robo- 
ter des vorliegenden Ausf uhrungsbeispiels im Unterschied zum 
Roboter nach dem Stand der Technik der AuSenlinie des Werk- 
stucks W ohne Uberschwingen schnell folgen kann. 

Mit dem vorliegenden Ausf uhrungsbeispiel werden die fol- 
genden wirkungen vorgesehen. 

(1) Da der Korrekturbetrag zum Bestimmen des Sollpunktes 
sich auf die Informationen, die vom Kraftsensor 22 ausgesen- 
det wurden, und die Informationen, die die Position und die 
Lage des Schleif steins 1 20 auf dem Abfuhlpunkt betref fen, 
stutzend berechnet wird, kann der Roboter eine spezielle Auf- 
gabe ohne Reduzierung seiner Betriebsgeschwindigkeit ganz ge- 
nau ausfuhren. 

(2) Da der Sollpunkt sich nicht nur auf die Informationen 
vom Kraftsensor 22 stutzend bestimmt wird, sondern sich eben-. 
falls auf die vorgabepunkte entlang eines Ref erenzpf ades 
stutzend, weicht der Roboter niemals vom gewunschten Pfad ab. 

(3) Sollpunkte werden in einem Zyklus, der kurzer als 
einhundert Millisekunden ist, auf einanderf olgend so bestimmt, 
dafi eine genaue Steuerung verwirklicht werden kann. 
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(4) Nach der Berechnung des Sollwertes werden die Posi- 
tion und die Lage des Werkzeugs 2 0 sich auf die Servokreise 
der sechs Achsen stutzend in der gleichen Weise wie nach dem 
Stand der Technik gesteuert. Der Roboter kann daher als ein 

5 gewohnlicher Vorgabewiedergaberoboter verwendet werden, wenn 
die Krafts teuerung nicht erforderlich ist. 

(5) Da die Ist-Steuerung der Position und der Lage des 
Werkzeugs 2 0 die gleiche wie die der Roboter nach dem Stand 
der Technik ist, kann die vorliegende Erfindung verwirklicht 

10 werden, indem nur eine neue CPtJ-Platine und eine neue 
Schnittstelle fur die Vorgabewiedergabe-Robotersteuerungsein- 
richtung nach dem Stand der Technik bereitgestellt werden. 
. Folglich kann der Roboter mit steuerbarer Kraft billig herge- 
stellt werden. 

15 (6) In seiner Eigenschaft als Bearbeitungsroboter kann 

dieser Roboter ebenfalls als eine Ausgleichvorrichtung ver- 
wendet werden: wenn die Bedienungsperson die Spitze des 
Kraftsensors 22 mit der Hand halt, urn ein durch den Roboter 
gehaltenes schweres Material einfach zu transportieren, steu- 

20 ert die Ausgleichvorrichtung die Transportr ichtung . 

(7) Wenn der Korrekturbetrag APT berechnet wird, wird ein 
Element der Matrix fur jede Berechnung in geeigneter Weise 
vorgesehen, so daS die Kraft nur in einer geforderten Axial - 
richtung reguliert wird. Fur eine Achse, bei der keine Not- 

25 wendigkeit der Krafts teuerung besteht, wird nur die Posi- 
tionss teuerung vorgesehen. 

(8) Da der Roboter das Eigengewicht des Werkzeugs regu- 
liert, kann dieses eine spezielle Aufgabe in einer wahlweisen 
Lage unabhangig von der Schwerkraft ausfuhren. 

30 Wahrend die Erfindung unter Bezugnahme auf ein bevorzug- 

tes Ausfuhrungsbei spiel gezeigt und beschrieben wurde, ist es 
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fur den Fachmann selbstverstandlich, daS zahlreiche andere 
Anderungen in der Form und in Einzelheiten vorgenommen werden 
konnen, ohne daS vom Geltungsbereich der Erf indung, der in 
den beigefugten Patentanspriichen festgelegt ist, abgewichen 
wird. 

Das vorliegende Ausf uhrungsbeispiel verwendet zum Bei- 
spiel einen Nachgiebigkeitsmechanismus (siehe Fig. 4) , der 
senkrecht zur Achse des Schleif steins 20 gleitet. Es ist 
ebenfalls moglich, einen Nachgiebigkeitsmechanismus 19a zu 
verwenden, der parallel zur Achse des Schleif steins 2 0a glei- 
tet, wie es durch einen Pfeil in Fig. 13 gezeigt ist. Fur 
diese Nachgiebigkeitsmechanismen 19 und 19a kann ein Nachgie- 
bigkeitssystem mit entferntem Zentrum, das im. allgemeinen RCC 
genannt wird, verwendet werden. 

In der vorliegenden Erf indung werden die Werkzeugposi - 
tionsdaten von den Kodierern 34, 44, 54, 64, 74 und 84 in der 
Koordinatenumwandlungsschaltung 40 8 vom Roboterkoordinatensy- 
stem zum Sensorkoordinatensystem umgewandelt. Die Idealposi- 
tion. wird dann in Form des Sensorkoordinatensystems berechnet 
und in der Koordinatenumwandlungsschaltung 418 zum Roboterko- 
ordinatensystem erneut timgewandelt . Alternativ dazu ist es 
moglich, die Kraftdaten vom Sensorkoordinatensystem zum Robo- 
terkoordinatensystem umzuwandeln, urn bei der Berechnung der 
Idealposition verwendet zu werden. In einem solchen Fall sind 
die Koordinatenumwandlungsschaltungen 40 8 und 418 in Fig. 6 
weggelassen; hinter der Sensorsteuerungseinrichtung 24 ist 
eine andere Koordinatenumwandlungsschaltung vorgesehen, um 
die Kraftdaten vom Sensorkoordinatensystem_zum Roboterkoordi- 
natensystem umzuwandeln. Auch in diesem Fall konnen die im 
vorliegenden Ausf uhrungsbeispiel beschriebenen Berechnungen 
verwendet werden, obwohl jeder Wert im Roboterkoordinatensy- 
stem angezeigt werden wurde. 



r 



27 

Deutschsprachige Ubersetzung der Patentanspruche 

der Europaischen Patentanmeldung Nr. 89 306 554.0-2302 

des Europaischen Patents Nr. 0 349 291 



Patentanspruche 



1. Trackingsteuerungsroboter (10) , der ein Werkzeug (R2) 
hat, das an einem Verschiebung- in- Kraf t-Umwandlungsmechanis - 
5 mus (R3) an einem Ende eines Arms des Roboters montiert ist, 
wobei die . Verschiebung- in- Kraf t - Umwandl ung s e inr i ch t ung zwi- 
schen der Kraft, die in eine Axialrichtung ausgeubt wird, und 
der Verschiebung zwischen dem Werkzeug und dem Armende in der 
gleichen Axialrichtung ein vorbestimmtes Verhaltnis in einem 
10 speziellen Koordinatensystem auf rechterhalt , 

wobei der Roboter das Armende (Rl) mittels einer Armende - 
Steuerungseinrichtung (R9) steuert, die die Position und die 
Lage des Armendes in Echtzeit zu auf einanderf olgenden Soll- 
punkten fur die Position und die Lage hin steuert, urn das 
15 Werkzeug (R2) zu bewegen, um einem Standardpfad zu folgen, 
der aus vorgespeicherten Positionsdaten erhalten wird, und um 
auf ein Werkstuck (W) mit einer voreingestellten Sollkraft 
einzuwirken, 

wobei der Roboter aufweist: 

20 Kodierer (34, 44, 54, 64, 74, 84), die mit jeder der je- 

weiligen Rotationsachsen des Roboters verbunden sind, 

eine Momentanzustand-Erf aSeinrichtung (R4) , die die Mo- 
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mentanposition und die Moment anl age des Armendes (Rl) erfafit, 
indem die Rotationswinkeldaten von deri Kodierern (34, .44, 54 
64, 74, 84) in Koordinaten fur die Momentanposition und die 
Moment anl age des Armendes unter Verwendung von Gleichungen 
fur kinematische Trans forma tionen umgewandelt werden, 

eine Ruckwirkungskraf t-Erf afieinrichtung (R5) zum Erfassen 
einer Ruckwirkungskraft, die vom Werkstuck (W) uber das werk- 
zeug (R2) und den Verschiebung- in- Kraft -Umwandlungsmechanis- 
mus zum Armende (Rl) ubertragen wird, 

eine Verschiebungsumwandlungseinrichtung (R6) , die die - 
Differenz zwischen der erfaSten Ruckwirkungskraft und einer 
voreinges tell ten Sollkraft des Werkzeugs (R2) berechnet und 
die Differenz in eine Verschiebung der Position des Armendes 
umwandelt, die benotigt wird, um diese Differenz Null zu set- 
zen, 

dadurch gekennzeichnet , da£ dieser ferner aufweist: 

eine Berechnungseinrichtung fur den modif izierten Soil- 
punkt, um sich auf den gegenwartigen Sollpunkt und auf die 
Verschiebung stutzend einen modif izierten Sollpunkt fur die 
Position und die Lage des Armendes (Rl) zu berechnen, 

und dafi die Berechnungseinrichtung fur den modif izierten 
Sollpunkt aufweist : 

eine Idealzustand-Berechnungseinrichtung (R7) , die Daten, 
die eine erfaSte Istposition und Istlage des Armendes zu 
einem bestimmten Zeitpunkt darstellen, und Daten aufnimmt, 
die die Verschiebung des Arms darstellen, die benotigt wird, 
um die Differenz zwischen der erfafiten Ruckwirkungskraft und 
einer voreingestellten Sollkraft fur den gleichen Zeitpunkt 
Null zu setzen, wobei die Idealzustand- Berechnungseinrichtung 
einen Punkt berechnet, der einer Position entspricht, die 
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eine Idealposition und Ideallage des Armendes (Rl) entspre- 
chend der erfaSten Istposition haben wiirde, wobei die Ideal - 
.position als erfaSte Istposition und Istlage des Armendes be- 
rechnet wird, die mit der berechneten Posit ionsverschiebung 
5 des Armendes ausgeglichen sind, die benotigt wird, um die 
Differenz zwischen der erfaSten Ruckwirkungskraf t und einer 
voreingestellten Sollkraft Null zu setzen, 

und 

eine Korrekturbetrag -Berechnungseinrichtung (R8). , die 
10 einen Korrekturbetrag fur den vorgespeicherten Standardpfad 
berechnet, indem die berechnete Idealposition und Ideallage 
des Armendes mit einer Ref erenzposition und Referenzlage des 
Armendes auf dem vorgespeicherten Standardpfad verglichen 
werden, 

15 und da£ 

der modifizierte Sollpunkt fur die Position und die Lage 
des Armendes (Rl) berechnet wird, indem die Ref erenzposition 
und die Referenzlage des Armendes auf dem vorgespeicherten 
Standardpfad entsprecherfd diesem Korrekturbetrag korrigiert 
20 werden . 



2. Trackings teuerungsroboter nach Anspruch 1, bei dem 

die Armende-Steuerungseinrichtung (R9) ~ Motoren (30, 40, 
50, 60, 70, 80) zum Antrieb des Armendes (Rl) aufweist und 

25 die Momentanzustand-Erf aSeinrichtung (R4) aufweist: einen 

Rotationssensor (34, 44, 54, 64, 74, 84) der an den Achsen 
der Motoren befestigt ist, und eine Einrichtung, um in Erwi- 
derung auf Signale vom Rotationssensor Positions- und Lageda- 
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ten fur das Ende des Sensors und Positions- und Lagedaten fur 
den Bearbeitungspunkt des Werkzeugs (R2) zu erzeugen, wobei 
sich die Daten auf einen vorbest immten Punkt irn Koordinaten- 
system stutzen, und um die Momentanposition und Momentanlage 
des Werkzeugs (R2) aus diesen Daten zu berechnen. 



3 , Trackingsteuerungsroboter 
Momentanzustand-Erf aSeinrichtung 
kraf t-ErfaSeinrichtung (R5) ihre 
multan ausfuhren. 



nach Anspruch 1, bei dem die 
(R4) und die Ruckwirkungs- 
jeweiligen Erf aSvorgange si- 



4. Trackingsteuerungsroboter nach Anspruch 1, bei dem die 
Ruckwirkungskraf t -Erf aSeinrichtung (R5) zwischen dem ver- 
schiebung- in- Kraft -Umwandlungsmechanismus (R3) und dem Werk- 
zeug (R2) vorgesehen ist, um einen Wert der Kraft am Ver- 
schiebung- in- Kraft -Umwandlungsmechanismus (R3 ) zu erf assen, 
wobei der erfa£te Wert die Differenz zwischen der Gravita- 
tionskraft am Werkzeug (R2) und der Ruckwirkungskraf t (Fw) 
ist, die vom Werkstuck (W) zum Werkzeug (R2) ubertragen wird. 



5-. Trackingsteuerungsroboter nach Anspruch l, bei dem die 
Verschiebungsumwandlungseinrichtung (R6) eine Einrichtung zum 
Berechnen eines Anderungsgrades der Ruckwirkungskraf t (Fw) 
entsprechend einem Anderungsgrad des Kraf twertes , der durch 
die Ruckwirkungskraf t- Erf aSeinrichtung (R5) erfaSt wird, . auf - 
weist . 



6. Trackingsteuerungsroboter nach Anspruch 1, bei dem die 
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Verschiebungsumwandlungseinrichtung (R6) eine Einrichtung hat 
zum Berechnen der Verschiebung der Position des Werkzeugs , so 
daS die Ruckwirkungskraf t (Fw) vom Werkstuck zum Werkzeug 
gleich der voreingestellten Sollkraft ist, indem eine Bewe- 
gungsglei chung des Werkzeugs (R2) als ein materielles Teil- 
chen verwendet wird, wobei' die Gleichung den Anderungsgrad 
der Ruckwirkungskraf t und einen viskositatskoef f izienten und 
eine Federkonstante fur den Verschiebung- in-Kraft-Umwand- 
lungsmechanismus (R3) aufweist. 



7. Trackingsteuerungsroboter nach Anspruch 6, bei dem die 
Ideal zus t and- Berechnungseinrichtung (R7) eine Einrichtung 
(416) zum Berechnen der Idealposition und Ideallage des Arm- 
endes (R3) entsprechend der Verschiebung der Position des 
Werkzeugs (R2) und der Momentanposition und Momentanlage des 
Armendes (R3) hat. 



8. Trackingsteuerungsroboter nach Anspruch l, bei dem der 
Roboter (10) eine Speichereinrichtung zum Halten von Daten 
der Ref erenzposition und der Referenzlage fur das Amende 
(R3) auf dem Standardpfad hat, wobei die Daten zuvor entspre- 
chend einem speziellen vorgabeverf ahren gespeichert werden, 
und die Korrekturbetrag- Berechnungseinrichtung (R8) eine Ein- 
richtung zum Auslesen der Ref erenzpositions - und Referenz- 
lage-Daten aus der Speichereinrichtung aufweist. 



9. Trackingsteuerungsroboter nach Anspruch 1, bei dem die 
Korrekturbetrag -Berechnungseinrichtung (R8) eine Einrichtung 
zum Berechnen einer Abweichung zwischen der Idealposition 
bzw. der Ideallage des Armendes und der Ref erenzposition bzw. 
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der Referenzlage des Armendes auf dem Standardpfad aufweist, 
urn den Korrekturbetrag fur die Position und die Lage des Arm- 
endes zu berechnen . 



5 10. Trackings teuerungsroboter nach Anspruch 1, bei dem 

die Korrekturbetrag -Berechnungseinrichtung (R8) eine Einrich- 
tung zum Modifizieren des Korrekturbetrages fur die Position 
und die Lage des Armendes (R3) urn einen voreingestellten Ver- 
setzwert aufweist. 

10 

11. Trackings teuerungsroboter nach Anspruch l, bei dem 
die Korrekturbetrag -Berechnungseinrichtung (R8) eine Einrich- 
tung hat, urn den Korrekturbetrag fur die Position und die La- 
ge des Armendes mit einem vorbestimmten Wert zu vergleichen 
15 und urn die Position und die Lage des Armendes in Echtzeit nur 
darm zu steuern, wenn der Korrekturbetrag geringer als der 
vorbestimmte Wert ist. 



12. Trackingsteuerungsroboter nach Anspruch 1, wobei das 
20 vorbestimmte Verhaltnis in einem Sensorkoordinatensystem vor- 
liegt, wobei der aus den vorgespeicherten Positionsdaten er- 
haltene Standardpfad in einem Roboterkoordinatensystem vor- 
liegt, wobei die Momentanposition und Momentanlage des Armen- 
des im Sensorkoordinatensystem vorliegen, ^wobei die Idealpo- 
25 sition und die Ideallage des Armendes im Sensorkoordinatensy- 
stem vorliegen, wobei die Umwandlungseinrichtung (418) vorge- 
sehen ist, um die Idealposition und Ideallage des Armendes 
vom Sensorkoordinatensystem in das Roboterkoordinatensystem 
umzuwandeln und wobei die Korrekturbetrag -Berechnungseinrich- 
30 tung (R8) den Korrekturbetrag fur die Position und die Lage 
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des Arms im Roboterkoordinatensystem berechnet, indem die urn- 
gewandelte Idealposition und Ideallage des Armendes mit der 
Referenzposition und der Referenzlage des Armendes auf dem 
Standardpfad verglichen werden. 



i 
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